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A  Mul ti — El ement  Ultrasonic  Ranging  Array 


One  of  the  first  issues  for  concern  in  the  evolution  of  a 
mobile  robot  design  is  the  need  to  provide  the  system  with 
sufficient  environmental  awareness  so  as  to  make  possible 
intelligent  movement.  The  first  step  towards  this  end  consists  of 
the  acquisition  of  appropriate  information  regarding  ranges  and 
bearings  to  nearby  objects,  and  the  subsequent  interpretation  of 
that  data.  Several  methods  for  approaching  this  problem  have  been 
proposed  and  investigated  by  numerous  researchers,  and  can  be 
broken  down  into  two  broad  categories:  passive  devices,  such  as 
stereoscopic  vision  and  swept-focus  ranging  systems,  and  active 
devices,  such  as  laser  and  ultrasonic  rangefinding  systems.  This 
article  describes  the  most  widely  used  ultrasonic  ranging  system 
employed  today  for  this  particular  application,  discusses  some  of 
the  problems  associated  with  its  use,  and  then  presents  one 
method  for  overcoming  some  of  these  problems  through  the  use  of 
multiple  transducers  arranged  in  a  sequentially  fired  array 
(Figure  1>,  with  temperature  compensation. 

The  ranging  modules  employed  on  ROBART  II  <MA  Second 
Generation  Autonomous  Sentry  Robot",  ROBOTICS  AGE-,  xxxxxxxxxx  85) 
were  made  by  Texas  Instruments  (Figure  2)  for  use  with  the 
Polaroid  electrostatic  ultrasonic  transducer,  and  were  selected 
due  to  their  low  cost,  high  reliability,  and  ease  of  interface. 
An  alternative  system  made  by  Massa  Products  Corporation  (Model 
E--200)  was  evaluated  but  not  selected  because  the  unit  cost  (over 
$160)  made  this  choice  impractical  for  a  mul t i -el ement  array 
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Figure  1 
show i ng 
single 
sensors 
Weapons 


Front  view  photo  ot  prototype  sentry  robot  ROBART  U, 
.4__  n-f  cpneors  in  five  element  sequential  array-  ine 
sad-mounted  sensor  shown  was  later  replaced  by ' 

1  depicted  in  Figure  3.  (Photo  courtesy  of  Naval  Surface 

enter,  White  Oak,  HD.) 
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Figure  2.  Line  drawing  of  the  Texas  Instruments  Ultrasonic 
Ranging  Module  made  for  use  with  the  Polaroid  electrostatic 
transducer.  Seven  such  hoards  are  interfaced  through  a  specially 
designed  multiplexer  to  a  single  parallel  port  on  the  controlling 
mi croprocessor . 
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requiring  several  modules-  By  comparison,  Polaroid  Corporation 
offers  both  the  transducer  and  ranging  module  circuit  board  for 
only  $35  a  set  when  purchased  in  quantities  of  ten-  An  improved 
version  of  the  circuit  board,  the  SN28S27,  is  now  available  from 
Texas  Instruments  which  greatly  reduces  the  parts  count  and  power 
consumption,  as  well  as  simplifying  computer  interface 
requirements  ("An  Ultrasonic  Ranging  System",  BYTE,  October  84). 

The  Polaroid  ranging  module  is  an  active  ti me-of —f 1 i ght 
device  developed  for  automatic  camera  focusing,  and  determines 
the  range  to  target  by  measuring  elapsed  time  between  the 
transmission  of  a  "chirp"  of  pulses  and  the  detected  echo.  The 
"chirp"  is  of  one  millisecond  duration  and  consists  of  four 
discrete  frequencies  transmitted  back-to-back:  8  cycles  at  60kHz, 
8  cycles  at  56kHz,  16  cycles  at  52.5kHz,  and  24  cycles  at 
49.41kHz.  This  technique  is  employed  to  increase  the  probability 
of  signal  reflection  from  the  target,  since  certain  surface 
characteristics  could'  in  fact  cancel  a  single-frequency  waveform, 
preventing  detection.  It  should  be  recognized,  however,  that  the 
one  millisecond  length  of  the  "chirp"  is  a  significant  source  of 
potential  error,  in  that,  sound  travels  roughly  1100  feet  per 
second  at  sea  level,  which  equates  to  about  13  inches  per 
millisecond.  The  uncertainty  and  hence  error  arises  from  the  fact 
that  it  is  not  known  which  of  the  four  frequencies  making  up  the 
"chirp"  actually  returned  to  trigger  the  receiver,  but  timing  the 
echo  always  begins  at  the  start  of  the  "chirp." 

A  second  very  important  characteri st i c  of  the  Polaroid 
system  is  the  use  of  a  stepped  gain  control  in  the  receiver 
section,  where  both  the  gain  and  the  Q  of  the  amplifier  are 
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transmi ssi on . 


increased  as  a  -function  of  time  following  "chirp" 

This  ensures  a  high  si gnal -to-noi se  ratio  while  matching  the 

relative  amplification  level  to  the  strength  of  the  returned 

echo,  which  decays  rapidly  as  a  function  of  distance  (and  hence 

time).  This  becomes  an  important  factor  in  the  design  of  an  array 

of  sequential  emitters,  where  residual  or  multiple  echos  could 

easily  confuse  the  next  element  in  the  array.  A  faint  residual 

echo  generated  by  a  previous  "chirp"  of  another  sensor  would  be 
/ 

j.n  all  probability  too  weak  for  detection  by  the  now  active 
rangefinder  since  its  own  gain  had  not  yet  been  increased  to  the 
requi red  1  eve I  - 

To  understand  the  advantages  of  the  sequential  array  it  is 
necessary  to  have  a  good  feel  for  the  strengths  and  weaknesses  of 
ultrasonic  ranging  in  general ,  keeping  in  mind  that  the  ultimate 
goal  is  to  be  able  to  repeatedly  obtain  accurate  range 
information  on  objects  surrounding  a  mobile  platform.  This 
dictates  that  power  consumption  be  kept  to  a  minimum  and  that  the 
system  be  capable  of  operating  in  real  time,  where  real  time 
depends  to  some  extent  on  how  fast  the  robot  travels.  These  two 
constraints  make  a  mechanically  positioned  sensor  less  than 
desirable,  in  that  precious  time  and  energy  are  wasted  while  the 
sensor  is  being  repositioned  to  take  ranges  in  a  new  direction. 
The  ideal  solution  would  be  to  employ  a  multitude  of 
prepositioned  transducers  that  could  be  individually  selected  at 
will,  thus  enabling  the  robot  to  get  range  information  in  any 
given  direction  at  any  particular  time.  Since  in  reality  there  is 
associated  with  each  sensor  some-2  overhead  in  terms  of  physical 
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Figure  3.  Front:  view  line  drawing  depicting  the  location  of 
various  sensors  which  provide  the  robot  with  information  on  its 
environment.  Temperature  sensor  at  right  in  diagram  on  lejft 
access  door  provides  information  to  correct  for  the  temperature 
dependence  of  the  speed  of  sound  in  air. 
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space  requirements,  power  consumption,  interface  circuitry,  and 
acquisition  cost,  an  array  sire  of  f i ve  transducers  was  chosen 
for  implementation  on  ROBART  II  <Figure  3).  In  addition,  two  more 
sensors  were  mounted  on  the  robot’s  head,  which  is  positi enable 
up  to  100  degrees  either  side  of  centerline.  This  configuration 
complements  the  fitted  array  for  rangefinding  outside  its  area  of 
coverage. 

For  any  ultrasonic  ranging  system  there  exists  a.  multitude 
^ 1  error  sources  that  must  be  understood  and  taken  into  account. 

t  __ 

In  Figure  4  it  is  shown  that  the  speed  of  sound  in  air  is 
proporti onal  to  the  square  root  of  temperature  in  degrees 
Rankine,  which  for  the  temperature  variations  likely  to  be 
encountered  in  this  application,  results  in  a  significant  effect 
even  considering  the  short  ranges  involved.  Temperature 
variations  over  the  span  of  60  to  80  degrees  F  can  produce  a 
range  error  as  large  as  7.8  inches  at  a  distance  of  35  feet. 
Fortunately,  this  situation  is  easily  remedied  through  the  use  of 
a  correction  factor  based  upon  the  actual  room  temperature, 
available  to  ROBART  II  with  an  accuracy  of  0.5  degrees  F  from  an 
external  sensor  mounted  on  the  left  access  door.  This  sen sor 
(Industrial  Computer  Designs,  Remote  Temperature  Sensor  RTS— 1) 
produces  an  output  voltage  which  varies  from  .80  to  4.80  volts 
over  the  temperature  range  of  20  to  120  degrees  F,  and  is 
interfaced  to  the  system  through  an  eight-bit  anal og-to-di q i tal 
converter  (Figure  5).  The  ranging  units  are  calibrated  at 
standard  room  temperature  (70  degrees  F) ,  and  then  the  correction 
factor  is  applied  to  adjust  for  actual  conditions.  The  formula  is 
simplyi  actual  range  equals  measured  range  times  the  correction 
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Speed  of  Sound  =  y/  gc  k  R  T 

Where:  c  =  speed  of  sound  (feet/second) 

9c  =  gravitational  constant 

k  =  ratio  of  specific  heats  (for  air  =  1 .4) 

R  =  gas  constant  for  a  specific  gas 
T  =  temperature  (degrees  Rankine) 

Substituting  in  appropriate  values  for  air  yields: 

c  =  V  (32.3)  (1.4)  (53.3)  T  =  49.018  y/Y  ft/sec 

Which  says  the  speed  of  sound  in  air  is  proportional  to  the  square  root  of  local 
temperature,  in  degrees  Rankine  (degrees  Farenheit  +  460  degrees). 

At  70  degrees  F:  c  =  49.018  y/  460  +  70  =  1128  ft/sec 

At  30  degrees  F:  c  =  49.018  \/  460  +  30  =  1085  ft/sec 

Distance  d  traveled  in  feet  over  time  t  seconds  is  given  by: 


d  =  ct  which  yields: 

where  subscripts  S  and  A 

d/^  /  ca  =  t  =  d$  /  cs  denote  "standard”  and  "actual" 

conditions,  respectively. 

Thus  the  formula  for  the  actual  distance  measured  by  an  ultrasonic  ranging  unit 
calibrated  at  standard  temperature  Ts  is: 

dA  =  <dS)  (ca/cs)  =  dS  V  Ta  /  Ts 


As  an  example,  for  a  system  calibrated  at  80°  F  operating  at  an  actual  temperature 
of  60°  F,  a  measured  range  of  35  feet  corresponds  to  an  actual  range  of 


dA  =  35 


460  +  60 


460  +  80 


34.35  feet 


For  an 
error  of 
7.8  inches 


Figure  4. 
of  sound 
con si dered 


Derivation  of  the  temperature  dependence  of  the  speed 
in  sir.  The  effects  of  humidity  on  k  and  R  are 
insignificant  for  this  discussion. 
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SYSTEM  ARCHITECTURE  -  ROBART  II 
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PWM 


16  CHANNEL 
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Fi pure  5.  Control  hierarchy  for  ROBART  II.  The  ambient 

temperature  sensor  is  interfaced  to  CF'LI  #2  via  a  16  channel  A/D 
converter.  The  7  ranging  modules  are  interfaced  to  CPU  #-•  through 
a  special  multiplexing  circuit  which  allows  them  to  be 
individually  activated  in  sequence  upon  command  from  the 
Schedul er . 
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factor,  where  the  correction  factor  is  the  square  root  of  the 
ratio  of  actual  temperature  to  standard  temperature,  in  deqrees 
Rankine.  The  possibility  does  still  exist,  however,  for 
temperature  gradients  between  the  sensor  and  the  target  to 
introduce  range  errors,  in  that  the  correction  factor  is  based  on 

the  actual  temperature  near  the  sensor  only. 

i  other  sources  of  error  can  be  attributed  to  properties 
of  the  target  itself,  the  transducer,  or  the  timing  and 
processing  circuitry  and  software.  Previously  it  was  mentioned 
that  the  one  millisecond  length  of  the  transmitted  "chirp" 
introduced  an  uncertainty  into  the  timing  process.  In  addition, 
random  electrical  or  ultrasonic  noise,  if  not  properly 
di scri mi nated  by  the  receiver  circuitry,  can  lead  to  erroneous 
information.  But  for  the  most  part  it  can  be  shown  that  the  more 
significant  errors  arise  from  the  various  ways  the  ultrasonic 
beam  emitted  by  the  transducer  interacts  with  the  target,  as 
discussed  be 1 ow * 

The  width  of  the  beam  is  determined  by  the  transducer 
diameter  and  the  operating  frequency.  The  higher  the  frequency  of 
the  emitted  energy,  the  narrower  and  more  directional  the  beam, 
and  hence  the  higher  the  angular  resolution.  Unfortunately,  an 
increase  in  frequency  also  causes  a  corresponding  increase  in 
signal  attenuation  in  air,  and  decreases  the  maximum  range  of  the 
system.  For  the  Polaroid  transducers  the  chosen  frequencies  which 
make  up  the  "chirp"  result  in  a  beam  width  of  appr ox i matel y 
thirty  degrees.  Best.  results  are  obtained  when  the  beam 
centerline  is  maintained  normal  to  the  target  surface.  As  the 
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angle  of  incidence  varies  from  the  perpendicular,  however,  note 
that  the  range  actually  being  measured  does  not  always  correspond 
to  that  associated  with  the  beam  centerline.  as  shown  in  Figure 
6.  The  beam  is  reflected  first  from  that  portion  of  the  target 
that,  is  closest  to  the  sensor.  In  fact,  at  a  distance  of  15  feet 
from  a  flat  target,  with  an  angle  of  incidence  of  70  degrees,  the 
theoretical  error  could  be  as  much  as  lo  inches,  in  that  the 
actual  line  of  measurement  intersects  the  target  surface  at  point 
B'  as  opposed  to  point  A.  The  problem  is  further  complicated  for 
surf  scs5  o-f  i  rregul  ar  shspe . 

The  width  of  the  beam  introduces  an  uncertainty  in  the 
perceived  distance  to  an  object  from  the  sensor,  but  an  even 
greater  uncertainty  in  the  angular  resolution  ot  the  object  s 


position.  A  very  narrow  vertical  target  such  as  a  long  wooden 
dowel  maintained  perpendicular  to  the  floor  would  have  associated 
with  it  a  relatively  large  region  of  floor  space  that  would 
essentially  appear  to  the  sensor  to  be  obstructed.  Worse  yet,  an 
opening  such  as  a  doorway  may  not  be  discernable  at  all  to  the 
robot  when  only  six  feet  away,  simply  because  at.  that  distance 
the  beam  is  wider  than  the  door  opening.  In  fact,  using  a  one 
inch  di ameter  vertical  dowel  as  a  target,  the  effective  beam 
width  of  the  F'olaroid  system  was  found  to  be  C'6  inches  a-_  a 
distance  of  only  6  feet  from  the  sensor.  The  doorway  detection 

problem  is  illustrated  in  Figures  10  and  11. 

Another  significant  error  occurs  when  the  angle  of  incidence 
of  the  beam  decreases  below  a  certain  critical  angle,  and  the 
reflected  energy  does  not  strike  the  transducer  (Figure  />.  This 
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Figure  6.  Due  to  beam  divergence,  ultrasonic  ranging  works  best 
when  the  beam  centerline  is  maintained  normal  to  the  target  s 
surface.  For  off  normal  conditions,  the  range  measured  does  not 
always  correspond  to  that  associated  with  the  beam  center  line. 


TRANSDUCER 


12 


Figure  7.  As  the  anqle  of  incidence  decreases  below  a  certain 
critical  angle,  the  reflected  energy  will  not  be  detected  by  the 
transducer,  resulting  in  erroneous  range  information.  For 
specular  reflection  from  smooth  surfaces,  the  angle  of  reflection 
/?  is  equal  to  the  angle  of  incidence  cC  . 
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occurs 


because  most  targets  are  specular  in  nature  with  respect 
to  the  relatively  long  wavelength  (roughly  1/4  inch.'  of 
ultrasonic  energy.  as  opposed  to  being  diffuse.  In  the  case  of 
specular  reflection,  the  angle  of  reflection  is  equal  to  the 
angle  of  incidence,  whereas  in  diffuse  reflection  energy  is 
scattered  in  various  directions,  caused  by  surface  irregularities 
equal  to  or  larger  than  the  wavelenth  of  incident  radiation.  The 
critical  angle  is  thus  a  function  of  the  operating  frequency 
chosen,  and  topographical  characteristics  of  the  target.  For  the 
sensors  used  on  ROBART  II  this  angle  turns  out  to  be 


approximately  65  degrees  for  a  flat  target  surface  made  up  ot 
unfinished  plywood.  In  Figure  8  the  ranging  system  would  not  see 
the  target  and  indicate  instead  maximum  range,  whereas  in  Figure 


9  the  range  reported  would  reflect  the  total  roundtrip  through 
points  A,  B,  and  C  as  opposed  to  just  A  and  B. 

The  relatively  long  range  capability  ( appr  ox  i  matel  y  feet.' 

of  the  Polaroid  system  makes  it.  well  suited  for  gathering  range 
data  for  both  navigational  planning  and  collision  avoidance. 
Navigational  planning  involves  mating  a  determination  of  where 
the  robot  is,  and  in  addition  its  particular  orientation  in  that 
spot,  as  well  as  the  subsequent  calculation  of  appropriate 
commands  to  move  the  robot  to  a  new  location  and  orientation.  The 
simplest,  case  reduces  the  problem  to  two  dimensions  with  a  priori 
knowledge  of  the  surroundings  in  the  form  of  a  memory  map,  o> 
world  model.  The  task  becomes  one  of  trying  to  correlate  a  real- 
world  sensor-generated  image  to  the  model,  and  extracting 
position  and  orientation  accordingly.  Several  factors  complicate 
the  problem. 
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Figure  8.  For  smooth  surfaces, 
the  wall  ahead  of  the  robot, 
maximum  range  instead. 


the  ranging  system  will  not  see 
and  will  erroneously  indicate 


Fiaure  9.  The  measured  range  will  reflect  the 
distance  through  points  A,  B«  and  C  as  oppo-ed  to 
distance  from  A  to  B. 


r  ound  trip 
the  actual 
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For  one  thing,,  the  real  environment  is  three-dimensional, 
and  althouqh  the  model  represents  each  object  as  its  projection 
on  the  X-Y  plane,  the  sensor  may  see  things  differently,  which 
complicates  the  task  of  correlation.  Secondly,  the  computational 
resources  required  are  large,  and  the  process  is  time  consuming, 
requiring  the  robot  at  times  to  "stop  and  think".  Also,  the 
acquisition  of  the  data  itself  can  take  several  seconds  using 
ultrasonic  ranging  techniques,  due  to  the  relatively  slow 
velocity  of  soundwaves  in  air.  More  importantly  for  the  purpos== 
of  this  discussion,  however,  are  the  effects  of  the  various  eri  or 
sources  previously  described,  which  can  collectively  impede  a 
solution  altogether. 

Fiqure  10  depicts  the  results  of  256  range  values  taken  by 


a  h ingle  s 

ensor  mounted 

on  the  head 

of  R0BART 

II,  with  the 

robot 

si tuated 

ap  p  r  ox i matel y 

5  feet  from 

the  wall 

as  shown.  The 

d  a  t  a 

took  appr 

OMimately  7 

seconds  to 

col  1 ec t 

as  the  head 

w  a  s 

mechanically  repositioned  between 

rang! ngs. 

The  process 

c  ou.l  d 

have  been  speeded  up  to  some  extent  by  reducing  the  number  of 
range  readings  taken  while  the  head  was  scanning.  Note,  however, 
in  Figure  10  that  only  two  positions  of  the  head  allowed  the  beam 
to  pass  through  the  doorway.  Had  the  number  of  positions  been 
reduced  from  256  to  100,  it  is  possible  that  the  doorway  would 

have  escaped  detection  altogether. 

resulting  plot  is  of  exceptional  quality  primarily  due 
to  the  nature  of  the  walls  themselves,  which  were  located  in  a 
basement  room  with  exposed  studs,  thereby  providing  excellent 
beam  return  properties.  The  proper  identification  of  the  open 
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Figure  10-  Plot  of  256  range  readings  taken  by  a  single 
mechanically  positioned  sensor  mounted  on  the  head  of  ROBART  II. 
An  open  doorway  is  detected  in  the  wall  approximately  5  feet 
directly  ahead  of  the  robot.  Note  the  excellent  correlation  with 
the  actual  wall  location.  (Plot  courtesy  of  Artificial 
Intelligence  Laboratory,  MIT.) 
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doorway,  and  the  excellent  correlation  with  the  actual  map  would 
provide  the  robot  with  a  highly  accurate  "-fix  It  should  be 
noted,  however,  that  the  room  was  "fairly  unci  utter^ed,  as  is  no>_ 
always  the  case  in  reality.  In  Figure  11  the  robot  was 
repositioned  7  "feet  away  "from  the  wall,  and  unable  to  detect  the 
opening.  For  situations  such  as  this  the  robot  needs  help  from 
other  types  of  sensors. 

Collision  avoidance  is  a  little  easier  to  address  in  that 
accuracies  are  less  important  and  the  computational  overhead 
nowhere  near  as  great.  The  intent  is  simply  to  be  aware  of 
obstructions  in  time  to  alter  course  to  avoid  them,  assuming  for 


the  time  being  that  the  issue  of  updating  the  world  model  to 
reflect  their  presence  is  deferred  until  later.  For  this 
application  the  sequential  array  can  improve  performance  over  a 
single  sensor  in  several  ways.  As  previously  discussed,  the  array 
allows  for  range  measurements  to  be  made  in  many  different, 
directions  very  quickly  with  minimal  power  consumption.  A  second 
advantage  comes  from  the  inherent  ability  to  employ  beam 
splitting  techniques  to  improve  the  angular  resolution,  already 
shown  to  be  extremely  poor  for  a  single  transducer. 

Beam  splitting  involves  the  use  of  two  or  more  rangefinders 
with  partially  overlapping  beam  patterns.  Figure  12  shows  how  for 
the  simplest  case  of  two  transducers,  twice  the  angular 
resolution  can  be  obtained  along  with  a  50  percent  increase  in 
coverage  area.  The  technique  is  extremely  simple:  if  the  target 
is  detected  by  both  sensors  A  and  B,  then  it  (or  at  least  a 
portion  of  it)  must  lie  in  the  region  of  overlap  shown  by  the 
shaded  area.  If  detected  by  A  but  not  B,  then  it  lies  in  the 
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Figure  11-  Plot  of  same  room  with  the  robot  now  situated 
approximately  7  feet  from  wall.  Due  to  beam  divergence  the 
doorway  is  no  longer  detectable  simply  because  at.  that  distance 
the  beam  is  wider  than  the  door  opening.  The  256  range  readings 
toot  approximately  7  seconds  to  collect.  (Plot  courtesy  of 
Artificial  Intelligence  Laboratory,  MIT.) 
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FOR  A  SINGLE  SENSOR 
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Increasing  the  number 


region  at  the  top  of  the  figure,  and  so  on. 
of  sensors  with  overlapping  beam  patterns  decreases  the  size  of 
the  respective  regions,  and  thus  increases  the  angular 
resolution.  The  sensor  pattern  employed  in  the  array  used  on 
ROBART  II  allowed  for  an  angular  resolution  of  2  degrees  when 
locating  a  one  inch  vertical  dowel  9  feet  from  the  robot,  a 
significant  improvement  over  the  30  degree  resolution  of  a  single 


transducer  - 

It  should  be  noted,  however ,  that  this  increase  in 

resolution  is  limited  to  the  case  of  a  discrete  target  in 
relatively  uncluttered  surroundings,  such  as  a  metal  pole 

supporting  an  overhead  load,  or  a  box  in  the  middle  of  the  floor. 
No  improvement  is  seen  for  the  case  of  an  opening  smaller  than  an 
individual  beam  width,  such  as  the  doorway  illustrated  in  Figure 
11.  The  entire  beam- from  at  least  one  sensor  must  pass.-  throuqn 
the  opening  without  striking  either  side  in  order  for  the  opening 
to  be  detected,  and  the  only  way  to  improve  resolution  otherwise 
is  to  decrease  the  individual  beam  widths  by  changing  transducers 
or  through  acoustical  focusing,  which  normally  is  impractical. 
Nevertheless,  the  sequential  array  provides  a  means  of  covering  a 
much  larger  area  in  a  shorter  amount  of  time,  in  most  cases  with 
far  better  resolution,  when  employed  for  purposes  of  collision 
avoi dance • 


Just  as  the  information  gathered  by  the  array  can  be  used  to 
avoid  an  object  in  the  path  of  the  robot,  it  can  also  be  used  to 
move  towards  or  even  "follow"  an  object.  As  ranges  are  repeatedly 
obtained  along  fixed  bearings  fanning  out.  in  the  direction  crt 
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travel ,  it  is  a  fairly  simple  matter  to  track  a  specified  target, 
within  the  field  of  view  even  while  both  the  target  and  robot  at  e 
in  motion.  This  technique  is  employed  on  ROBART  II  when  in  the 
sentry  mode  to  acquire  and  then  track  an  intruder  detected  by 
any  of  the  system's  many  intrusion  sensors.  The  robot's  mean 
forward  velocity  is  adjusted  as  a  function  of  range  to  the 
target,  and  then  a  calculated  differential  in  left  and  right 
drive  motor  speeds  is  introduced  as  a  function  of  how  far  off 
centerline  the  target  appears.  This  causes  the  robot  to  turn 
towards  the  target  being  followed  in  a  controlled  fashion,  until 
it  appears  centered,  all  the  while  maintaining  a  specified 

i nterval . 

The  ultrasonic  transducers  on  ROBART  II  are  mounted  from  the 
inside  of  a  13  inch  diameter  section  of  plastic  pipe  which  forms 
the  upper  body  housing.  In  order  to  achieve  the  desired  fanout 
angle  of  9  degrees  between  beam  centerlines  for  adjacent  units, 
the  mounting  holes  had  to  be  staggered,  essentially  creating  two 
rows,  with  three  sensors  on  the  bottom  row  and  two  on  the  top.  To 
increase  the  vertical  coverage  somewhat  the  top  row  was  situated 
11  inches  above  the  bottom  row,  which  in  turn  is  located  IB 
inches  above  the  f 1 oor .  Additional  vertical  coverage  can  be 
gained  if  one  of  the  head  mounted  sensors  is  positioned  on 
centerline  and  operated  in  conjunction  with  the  array,  thus 
providing  maximum  protection  in  the  direction  of  travel  for  the 
full  height  of  the  robot. 

To  simplify  the  circuitry  involved,  all  timing  and  time  to 
distance  conversions  are  done  in  software.  Three  control  lines 
are  involved  in  the  interface  of  the  Polaroid  ultrasonic 
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circuitboard  to  a  microprocessor.  The  first  of  these,  referred  to 
as  VSW  (Figure  13)  initiates  operation  when  brought  high  to  +5 
volts.  A  second  line  labelled  XLOB  signals  the  start  of  pulse 
transmission,  while  the  line  labelled  liFL-06  indicates  detection 
of  the  first  echo.  The  controlling  microprocessor  must  therefore 
send  VSW  high,  monitor  the  state  of  XLOG  and  commence  timing  when 
transmission  begins  (appro* i matel y  5  mi  1 1 i seconds  later),  and 
then  poll  MFLOG  until  an  echo  is  detected  or  sufficient  time 

elapses  to  indicate  there  is  no  echo. 

Since  sound  travels  rather  slowly  in  air,  a  lot  of  CPU  time 
will  be  wasted  waiting  for  echos,  and  fast  range  update  rates 
will  effectively  tie  up  the  microprocessor  and  interfere  with 
other  tasks.  Fortunately,  however,  small  dedicated  controllers 
which  can  be  slaved  to  the  master  microprocessor  are  readily 
available  at  low  cost,  and  all -CMOS  versions  feature  low  power 
consumptions  which-,  make  them  attractive  alternatives  to 
specialized  circuitry.  ROBART  II  employs  a  65SC02-based  HHL.-02 
controller  manufactured  by  R.J.  Brachman  Associates  which  is 
ideal  for  this  task,  designated  as  CPU  #3  (Figure  5).  Two  65SC22 
Versatile  Interface  Adapters  provide  32  general  purpose  I/O  lines 
as  well  as  B  handshake/control  lines,  with  an  8  kilobyte  onboard 
address  space.  Total  power  consumption  is  less  than  35  mill  lamps. 

The  7  ultrasonic  ranging  units  are  interfaced  to  CPU  #3 
through  a  three-circuit  eight-channel  multiplexer  utilizing  4u_d 
analog  switches  operating  in  the  digital  mode,  as  shown  in  Figure 
14.  This  way  the  microprocessor  "sees"  only  one  ranging  unit  at  a 
time  through  the  multiplexer,  and  the  software  merely  executes  in 
a  loop,  incrementing  each  time  the  index  which  enables  a  specific 


24 


4050 


VSW 


vsw 


XLOG 


MFL06 


I 


3 

14 

11 

15 

12 

■  10 

1 

5 

g 

? 

4051 


MFLOG 


3 

13- 

ii 

14 

1  1 

10 

1  J 

12 

1 

5 

2. 

g 

4051 


\ 


VSW  #0 

T~\-+~  vsw  #i 

_  VSW  A2 

£T >  VSW  #3 
VSW  #4 

vsw  #5 

VSW  #6 


TO  ALL 
RANGING 
MODULES 
(FIG.  2) 


XLOG  #0 
XLOG  #1 
XLOG  a2 
XLOG  #3 
XLOG  #4 
XLOG  #5 
XLOG  #6 


FROM  ALL 
RANGING 
MODULES 
(FIG.  2) 


\ 

.  MFLOG  AO 

-Q3“<  MFL0G  #1 

<  MFLOG  A2 
d  y<  MFLOG  A3 

<  MFLOG  A4 

MFLOG  A5 

MFLOG  A6 
/ 


FROM  ALL 
RANGING 
MODULES 
(FIG.  2) 


4050 


Figure  14.  Schemati 
4051  analog  switches 
and  7  grounded.  Only 
by  the  binary  number 
#3. 


c  diagram  -for  the  multiplexer  inter-face.  The 
are  operated  in  the  digital  mode  with  pins  o 
one  channel  at  a  time  is  enabled,  determined 
on  select  lines  AO,  Al.  and  A2,  set  by  U-PU 


25 


ranging  unit.  Three  I/O  lines  from  the  MMC-02  handle  this 
enabling  function,  activating  simultaneously  the  4051 

multiplexers  for  VSW,  XLOG,  and  liFLOG .  The  binary  number  placed 
on  these  I/O  lines  by  the  mi croprocessor  determines  which  channel 
is  selected,  all  other  channels  assume  a  high  impedance  state. 
Three  other  I/O  lines  carry  the  logic  inputs  to  the 

fn  i  cr  opr  oc  e  ssor  from  the  multiplexers  for  XLOG  and  MFLOG,  and  from 
the  mi croprocessor  to  the  multiplexer  for  VSW.  A  final  I/O  line 
Qf-j  the  same  port  is  used  to  power  down  the  interface  circuit!  y 
and  the  ranging  units  when  not  in  use  to  save  battery  power.  The 
ranging  module  circuitboards,  CPU  #3,  and  the  multiplexer  board 
are  depicted  in  the  photo  of  the  robot ' s  removable  electronics 
package,  Figure  15. 

A  second  parallel  port  on  the  MMC-02  is  used  to  receive 
commands  from  the  Scheduler  which  tell  CPU  #3  to  power  up  the 
ranging  units,  and  then  which  sensors  to  sequentially  activate. 
Commands  are  in  the  form  of  an  eight— bit  binary  number 
represented  in  hexadecimal  format,  where  the  upper  nibble 
represents  the  starting  ID  and  the  lower  nibble  the  ending  ID  for 
the  sequence.  For  example,  the  command  $  1 6>  would  mean  activate 
and  take  ranges  using  sensors  #1  through  #6  sequentially,  whereas 
the  command  $44  would  cause  only'  sensor  #4  in  the  array  to  be 
repeatedly  activated.  Each  time  through  the  loop  upon  completion 
of  the  sequence,  the  stored  ranges  are  transmitted  up  the 
hierarchy  to  the  Scheduler  over  an  RS-232  serial  link,  with 
appropriate  handshaking.  The  sequence  is  repeated  in  similar 
fashion  until  such  time  as  the  Scheduler  sends  a  new  command 
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Fiaure  15.  Photo  showing  removable  electronics  package.  Five  of 
the  ultrasonic  ranging  modules  are  seen  at  the  extreme  right  of 
the  assembly.  The  foil  side  of  the  multiplexer  circuitboard  is 
just  visible  through  the  plexiglass  on  the  swingout  panel,  behind 
which  can  be  seen  CPU  #2,  CPU  #3,  and  CPU  #4,  mounted  on  the 
ricjht  s-ide  of  the  card  cage.  (Photo  courtesy  of  Naval  Surface 
Weapons  Center,  White  Dak,  MD. > 
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down,  or  advises  CPU  #3  to  power  down  the  ranging  system  with  the 
special  command  $FF. 

The  software  is  structured  as  shown  in  Figure  16,  When 
energized  by  the  Scheduler,  CPU  #3  does  a  power-on  reset, 
initializes  all  ports  and  registers,  and  then  waits  for  a 
command.  When  a  command  is  latched  into  Port  A  of  the  65SC22,  a 
flag  is  set  automatically  that  alerts  the  mi croprocessor ,  which 

then  reads  the  command  and  determines  the  starting  and  ending 

( 

identities  of  the  rangefinders  to  be  sequentially  activated.  1  he 
interface  circuitry  and  ranging  units  are  then  powered  up,  and 
the  Y  Register  is  set  to  the  value  of  the  first,  transducer  to  be 


fired. 

Subroutine  PIN6  is  then  called,  which  enables  the  particular- 
channel  of  the  multiplexer  interface  dictated  by  the  contents  of 
the  Y  Fseqi  ster .  The  VSW  control  line  is  sent  high,  which 
initiates  operation  of  the  selected  ranging  module.  The  software 
then  watches  the  multiplexer  output  XLOG  for  indication  of  pulse 
transmission,  before  entering  the  timing  loop.  Each  pass  through 
the  timing  loop  corresponds  to  a  tenth  of  an  inch  in  range 
measurement ,  in  that  sound  travels  exactly  O.-zO  inches  in  the 
time  required  for  loop  execution,  at  the  system  calibration 
temperature  of  70  degrees  F.  The  contents  of  the  loop  counter 
register  RANGE  thus  correspond  to  the  number  of  tenths  of  inches 
to  the  target.  If  this  value  ever  exceeds  the  maximum  specified 
range  of  the  system,  the  software  will  exit  the  loop,  otherwise 
the  counter  is  incremented  until  HFLOB  is  observed  to  go  high, 
indicating  echo  detection.  Upon  exit  from  the  timing  loop,  the 
range  value  for  that  particular  ranging  module  is  saved  in 


28 


indexed  storage,  and  Subroutine  PING  returns  to  the  main  program. 

The  Y  Register  is  then  incremented  to  enable  the  next 
ranging  module  in  the  sequence,  and  Subroutine  PING  is  called 
aqain  as  before.  This  process  is  repeated  until  the  V  Register 
equals  the  value  of  the  ending  index,  signifying  that  all  modules 
ip  sequence  specified  by'  the  Scheduler  have  been  activated 

individually.  CPU  #3  then  requests  permission  from  the  Scheduler 
to  transmit  all  the  stored  range  values  via  the  RS-232.  When 
acknowledged,  the  ranges  are  sequentially  dumped  out  the  serial 
interface  and  placed  by  the  Scheduler  in  Page  Zero  indexed 
storaqe.  Upon  completion,  CPU  #3  checks  to  see  if  a  new  command 
has  been  sent  down  altering  the  ranging  sequence,  and  then 
repeats  the  process  u s i  n q  the  a p p r o p r i a t e  st sr ting  and  ending 
indexes.  Thus  the  software  runs  continuously  in  a  repetitive 
fashion,  sequentially  activating  the  specified  ranging  modules, 
converting  elapsed  time  to  distance,  storing  the  individual 
results,  and  then  finally  transmitting  all  range  data  at.  once  to 
the  Scheduler,  which  is  thus  freed  from  all  associated  overhead. 

In  conclusion,  the  implementation  of  the  sequential  ranging 
array  using  a  small  dedicated  microprocessor  such  as  the  MMC-02 
offers  several  advantages  to  a  mobile  robot  design.  As  seen 
above,  the  controlling  microprocessor  is  unburdened  of  the  lower 
le^vel  functions  such  as  control  line  mani  pul  at  i  on ,  timing,  ancl 
conversion.  Several  prepiosi  t  i  oned  sensor's  allow  data  to  be  taken 
at  a  faster  rate,  with  less  power  consumption,  and  fewer  errors 
associated  with  actual  sensor  position  than  the  alternative 
mechanically-positioned  single-sensor  systems.  Improvements  .in 
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iqure  It.,,  Flowchart  for  the  system  software  which  runs  on  CPU 
3~  Subroutine  PING  activates  and  times  individual  ranging 
modules  as  dictated  by  the  contents  of  the  Y  Register.  Commands 
are  sent  down  by  the  Scheduler  to  specify  the  sequence  of  modules 
to  be  activated- 


angular  resolution  can  be  gained  through  the  use  of  beam 
splitting  techniques,  and  temperature  correction  can  be  employed 
to  increase  range  accuracy.  The  array  thus  exploits  the 
properties  of  ultrasonic  ranging  for  those  applications  best 
served,  such  as  collision  avoidance  or  object  tracking,  where 
absolute  accuracies  are  not  as  important  as  is  relative 
information.  For  other  applications,  such  as-  n  a  ■/  i  g  a  t  i  o  n  and  map 
correlation  in  cluttered  environments,  where  precision  becomes  an 
important  factor,  compl ementary  sensors  with  appropriate 
characteristics  must  be  brought  to  bear  for  optimum  results.  The 
relatively  long  wavelength,  poor  angular  resolution,  temperature 
dependence,  and  slow  speed  of  sound  in  air  become  significant 
drawbacks,  and  near-infrared  and  laser  based  rangefinders  should 
be  considered  as  alternative  approaches. 
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